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I.  STATEMENT  OF  THE  PROBLEM 


The  goal  of  this  project  is  to  improve  the  accuracy  of  rate  control 
systems.  The  traditional  direct-fire  gun-type  turret  has  an  accuracy 
requirement  on  the  order  of  0.2  railliradians  which  is  sufficient  for 
ranges  of  from  one  to  two  kilometers.  Laser  designators  and  guided 
missile  directors  are  designed  for  twice  the  range  and  therefore  require 
twice  the  accuracy,  i.e.,  approximately  0.1  milliradians .  Even  the  best 
modern  turret  systems  have  trouble  achieving  this  order  of  accuracy  all 
the  time.  This  effort  attempts  to  determine  which  system  character¬ 
istics  are  limiting  tracking  accuracy.  It  will  then  be  possible  to 
write  specifications  in  terms  of  hardware  characteristics  rather  than 
in  terms  of  system  performance  goals. 

The  premise  of  this  approach  is  that  the  solution  can  be  found  in 
the  nonlinear  behavior  of  the  turret  systems  at  very  low  rates.  The 
tracking  rates  of  interest  and  changes  in  rate  that  are  called  for  to 
achieve  precise  tracking  are  very  small.  A  30-kilometer-per-hour  target, 
for  example,  at  a  range  of  4  kilometers  and  a  heading  of  30  degrees 
would  result  in  a  l-milliradian-per-second  crossing  rate.  The  gunner 
will  command  small  changes  about  this  nominal  rate  in  an  attempt  to 
reduce  the  tracking  error.  We  can  infer  the  magnitude  of  these  changes 
to  be  less  than  0.3  milliradians  per  second  (referred  to  the  output)  by 
the  following  logic.  Since  the  desired  error  tolerance  is  on  the  order 
of  0,1  milliradians  the  gunner  should  have  the  ability  to  make  commands 
at  his  bandwidth  (3  radians  per  second)  which  would  result  in  amplitudes 
of  O.l  milliradian.  Assuming  a  sinusoidal  input  of  0.3-milliradian-per- 
second  amplitude  and  3-radian- per- second  frequency  the  output  would  be  a 
sinusoid  with  0. 1-milliradian  amplitude. 

The  nonlinear  elements  in  the  turret,  i.e.,  backlash,  coulomb 
friction,  and  deadspace,  will  have  more  effect  on  the  turret  response 
at  low  rates  and  for  small  commands.  The  gunner  will  notice  a  decrease 
in  gain  and  an  increase  in  phase  lag.  He  will  attempt  to  compensate 
for  the  turret  changes  within  limits,  but  eventually  the  tracking 
error  will  increase  above  what  it  would  be  for  a  linear  system. 
Moreover,  the  human's  ability  to  compensate  will  vary  considerably 
with  training  and  between  people.  The  result  will  be  unpredictable 
system  performance  due  to  operator  differences  rather  than  hardware 
differences . 

Traditionally  the'  turret  specifications  for  low  rate  tracking 
have  been  system  performance  specifications  with  a  human  operator  in 
the  loop,  e.g.,  0. 1-milliradian  root-mean- square  error  when  tracking 
a  1 .0-mil 1 ir ad ian- per- second  target  for  10  seconds.  It  would  probably 
be  better  to  specify  the  accuracy  requirements  aga..nst  sinusoidal 
inputs  and  better  still  to  specify  the  system  characteristics  without 
a  human  operator  in  the  loop.  Enough  analysis  of  linear  control 
systems  with  human  operators  has  been  done  to  relate  accuracy  to 
system  characteristics  (gain  and  phase  lag)  and  input  power  spectra  at 
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least  for  linear  control  systems.  This  report  addresses  the  system 
performance  at  low  rates  when  the  nonlinear  system  characteristics  are 
important.  Ultimately  this  work  should  lead  to  specifications  of 
system  characteristics  which  are  required  to  achieve  any  specified 
degree  of  accuracy. 


II.  APPROACH 

The  overall  solution  to  the  problem  requires  three  distinct  tasks 
to  be  carried  out  by  three  different  organizations. 

a.  First,  there  is  the  characterization  of  a  typical  turret 
control  system  at  very  low  rates.  An  M60A3  turret  control  is  being 
used  because  it  is  available  now  and  in  the  future  and  it  is  typical 
of  current  military  turret  control  systems.  Frequency  response  and 
transient  response  will  be  measured  at  various  amplitudes  from  low 
rates  near  or  below  threshold  up  to  high  rates  in  the  linear  region. 
This  work  is  being  done  under  contract  by  Ceneral  Flectric, 
Pittsfield,  Massachusetts. 

b.  Second,  there  are  experiments  with  humans  in  the  loop  and 

with  computer  simulated  turret  response.  These  tests  will  charac¬ 
terize  the  human  operator  and  they  will  allow  for  some  limited  para¬ 
meter  variations  of  turret  response.  Human  Engineering  Laboratory  is 
doing  this  work.  ^ 

c.  Third,  there  is  an  analysis  task  with  both  the  turret 
response  and  the  human  operator  simulated  by  a  computer.  This  task 
allows  for  parametric  variations  of  turret  response  just  as  with  the 
human  experiments;  but  the  computer  allows  for  almost  unlimited  para¬ 
meter  variations  because  the  trials  are  faster  and  they  are  without 
random  human  variation.  This  report  describes  the  Phase  I  effort  on 
the  third  task. 

The  Phase  I  effort  develops  the  methods  and  computer  codes  based 
on  assumed  system  characteristics.  The  Phase  II  effort  will  do  it  all 
again  but  with  accurate  system  data  from  the  other  tasks. 

The  main  task  of  Phase  I  was  to  develop  a  self-opt  imlztng  Viuman 
operator  model.  The  model  must  minimize  root  mean  square  (rms) 
tracking  error,  subject  to  constraints  on  human  behavior,  in  a 
consistent  and  rational  manner.  This  model  was  then  used  to  determine 
the  effects  of  various  kinds  of  nonlinearities  on  system  performance. 
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III.  PROCEDURE  FOR  MAN-MODEL  OPTIMTEATION 


The  Phase  T  effort  had  a  f»oal  of  developing  techniques  for 
evaluating  nonlinearities.  This  Included  the  man  model,  the  adaptive 
algorithm  for  the  man  model,  models  of  nonlinearities  and  some  limited 
data  to  show  how  well  the  models  work.  Complicated  turret  dynamics 
were  not  important  at  this  stage;  consequently  a  very  simplified  model 
of  turret  response  was  Incorporated.  Figure  1  shows  a  block  diagram 
of  the  control  loop  and  the  linear  models  that  were  used  for  the  man 
and  turret.  The  reference  signal  was  either  white  noise,  a  sinusoid, 
or  a  maneuvering  tank.  The  human  model  was  a  conventional  linear 
model  from  Sheridan^  to  which  a  noise  remnant  was  added  for  reasons 
that  will  be  explained  later.  The  turret  response  was  given  a  time 
constant  of  0.1  seconds  and  a  gain  of  0.01  radians  per  second  per 
radian.  These  parameters  are  about  right  for  a  tank  turret  at  very 
low  rates.  Nonllnearltles  were  introduced  in  the  digital  simulation 
at  the  points  shown  in  Figure  1. 

The  notation  in  Figure  1  was  chosen  to  he  consistent  with  the 
digital  sinnilation  shown  in  its  entirety  in  the  Appendix.  The  linear 
transfer  functions  were  simulated  by  the  step  invariant  zeta  transform- 
method. 


Figure  1.  Block  Diagram  of  Control  Loop  . 


^Man-Machine  Systems,  Sheridan  and  Ferrell,  1*^74,  MIT  Press. 
^Digital  Signal  Analysis,  Stearns,  l'»7!>,  Hayden  Book  Company  Tpc. 


An  algorithm  for  optimizing  the  human  transfer  function  was 
developed  while  using  white  noise  for  a  reference  signal.  It  minimized 
rms  tracking  error  but  with  a  penalty  for  open  loop  gain  margin  less 
than  6  db  and  open  loop  phase  margin  less  than  45  degrees.  Secant 
functions  accomplished  the  penalty  by  giving  a  cost  factor  of  one  at  6 
db  and  45  degrees  and  a  cost  factor  of  infinity  at  0  db  and  0  degrees . 

secant  {15  (Gain  Margin  -6)],  secant  (2  (Phase  Margin  -45)1 

The  loop  was  warmed  up  for  a  few  seconds,  run  for  52  seconds  at  a  time 
step  of  0.01  seconds,  and  sampled  every  .05  seconds  till  1024  samples 
of  input  to  the  man  and  output  from  the  plant  were  stored.  A  fast 
fourier  transform  was  taken  of  the  input  and  output.  The  open  loop 

gain  and  phase  were  calculated  from  zero  to  ten  radians  per  second  at 

intervals  of  one  radian  per  second  by  adding  the  complex  numbers  in 

every  eight  cells  and  then  dividing  the  absolute  values  to  get  gain 
and  subtracting  the  angles  to  get  phase.  The  computer  program  plots 
the  resulting  gain  and  phase  and  it  calculates  the  cost.  It  selects 
new  values  for  the  human  transfer  function  and  then  repeats  the 
simulation  and  cost  calculations  until  a  minimum  is  established. 

The  human  transfer  function  optimization  algorithm  worked  fine 
with  a  white  noise  input.  There  was  enough  power  at  every  frequency 
of  interest  to  make  good  calculations  of  gain  and  phase.  The  gain 

calculation  becomes  noisy  when  the  input  (the  denominator)  gets  near 
zero.  The  phase  calculation  gets  noisy  when  either  the  input  or 

output  power  gets  too  small  to  make  an  accurate  phase  measurement. 
The  algorithm  requires  smooth  monotonically-decreasing  gain  and  phase 
for  at  least  one  frequency  band  beyond  180  degree  phase  lag.  Such 
data  were  obtained  with  a  white  noise  input  with  and  without 
nonlinearities  in  the  loop.  Unfortunately  real  targets  do  not  present 
a  white  noise  tracking  spectrum. 

A  realistic  target  motion  was  constructed  from  tlie  following 
considerations; 

a.  The  algorithm  wants  as  much  power  as  possible  and  so  does  the 
maneuvering  target-,  therefore  a  course  made  of  segments  of  0.2g  turns 
was  used. 

b.  The  target  wants  to  move  forward  rather  than  go  in  a  circle; 
therefore  the  turns  were  limited  to  plus  and  minus  45  degrees  from  the 
line  of  sight  between  the  target  and  tracker. 
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c.  The  algorithm  wants  power  in  ea-jh  one-radian-per-second 
frequency  band,  therefore  the  turning  radius  and  speed  were  selected 
to  produce  a  fundamental  frequency  at  0.5  radian  per  second  so  that 

the  harmonics  would  fall  at  1,5,  2.5,  3,5 . radians  per  second. 

The  relationships  for  radial  acceleration  were  used. 

radial  acceleration  =  rw^  »  v^/r  “  0.2g 
r  =  radius  =»  8  meters 

w  “  angular  rate  *»  0.5  radians  per  second 

g  »  acceleration  of  gravity  »  10  meters  per  second  squared 

d.  The  range  to  target  was  set  at  four  kilometers  to  reduce  the 
angular  tracking  rates  co  the  low  rates  of  interest. 

Maximum  rate  «  4  m/s  *  (sin  45)/4  km  “  0.7  mrad/s 

These  considerations  resulted  in  a  course  v^ich  was  roughly  sinusoidal 
at  0.5  radians  per  second.  The  abrupt  changes  in  radial  acceleration 
every  90  degrees  of  turn  gave  strong  enough  harmonics  to  allow  the 
algorithm  to  calculate  gain  and  phase  when  there  were  no  nonlinear¬ 
ities  in  the  loop,  although  it  did  require  double  precision  in  the 
calculations.  When  nonlinearities  were  introduced  the  gain  and  phase 
curves  became  noisy  and  the  optimization  algorithm  would  not  work. 

Additional  power  was  required  at  both  the  input  and  output  at 
frequencies  of  interest  (1,5  through  8.5)  to  make  the  optimization 
algorithm  work  properly.  Fortunately  the  addition  of  noise  power  is 
justified  as  the  so-called  remnant  term  of  the  human  transfer  function 
(Yj|) .  Although  it  can  be  added  either  before  or  after  the  linear 
portion  of  Yjj,  here  it  is  added  before  Y^^  to  enhance  the 
optimization  algorithm  operation,  but  after  the  rms  calculation  to 
avoid  improperly  affecting  it.  The  appropriate  amount  of  noise  wa« 
calculated  by  the  following  steps: 

a.  Sheridan  page  241  shows  the  noise  power  to  be  20  percent  of 
the  total  power  at  the  output  of  the  man.  Page  242  shows  it  to  be 
uniform  with  frequency. 

b.  The  Yp  can  be  approximated  by  a  pure  gain  for  power 
calculations,  because  the  transportation  delay  does  not  affect  power 
and  the  lead-lag  terms  are  very  small. 

c.  Sample  trials  have  shown  the  rms  error  to  be  approximately 
0.3  milliradians . 

d.  There  are  approximately  eight  bands  of  interest. 


e.  Therefore  power  from  a  sinusoid  with  an  rras  amplitude  of  0.05 
milliradians  should  be  introduced  at  each  frequency  band. 

0.3  VO.2/8  ■  0.05 


This  additional  power  helped  but  sooner  or  later  as  the  magnitude  of 
the  nonlinearities  was  increased  the  algorithm  would  become  too  noisy. 
There  are  still  a  couple  of  tricks  to  try,  i.e.,  longer  running  time  and 
extrapolation  of  the  phase  curve  to  180  degrees  lag  rather  than  inter¬ 
polation  as  was  done  here.  These  will  be  tried  in  the  Phase  II  effort.  The 
current  effort  was  finished  by  using  the  simple  expedient  of  minimizing  rms 
error  and  forgetting  about  the  phase  and  gain  calculations.  This  procedure 
raised  the  gain  until  the  system  went  unstable.  It  is  a  consistent  method 
but  it  is  probably  not  typical  of  human  operation. 


IV.  EFFECTS  OF  NONLINEARITIES  ON  THE  TURRET  RESPONSE 

Three  nonlinearities  were  added  one  at  time.  Deadspace  was  added  at  G3 
on  Figure  1.  It  corresponds  to  the  deadspace  in  a  gunner's  control  for  the 
first  couple  of  degrees  of  rotation.  Coulomb  friction  was  added  at  G4,  It 
corresponds  to  the  friction  on  the  turret  itself.  Backlash  was  applied  to 
the  output  at  H  and  it  can  also  be  applied  to  the  input  at  G3. 

Figure  2  through  Figure  6  show  the  effects  of  these  nonlinearities  on 
the  gain  and  phase  characteristics  of  the  turret,  i.e.,  from  G3  to  H. 
Figure  2  shows  the  turret  with  no  nonlinearities  for  a  comparison.  The 
turret  parameters  were  B  =  10,  KB  =»  1.0,  and  J  “  1.0.  These  curves  were 
generated  by  using  a  single  sinusoid  by  itself  at  each  frequency.  The 
family  of  curves  in  Figure  3  through  Figure  6  represents  successive  doubling 


Figure  2.  Turret  Keeponte  Without  Honlineeritie*. 
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of  the  ratio  of  the  nonlinearity  to  the  input.  It  was  done  by  changing  the 
input  rather  than  the  turret.  This  procedure  is  equivalent  to  the  way  the 
test  data  would  be  collected  on  a  turret.  The  input  amplitudes  were  0.125, 
0.25,  0.5,  1,  2,  4  and  8  milliradians . 

The  phase  lag  shown  in  Figure  2  points  out  a  limitation  of  this 
methodology.  A  quick  calculation  would  predict  a  lag  of  135  degrees  at  10 
radians  per  second.  The  figure  shows  a  lag  of  150  degrees.  The  difference 
of  15  degrees  must  be  due  to  the  analysis  technique  which  uses  the  Zeta 
transform  and  the  Fast  Fourier  Transform.  The  time  step  used  with  the 
simulation  can  account  for  6  degrees  of  error  (0.01  seconds  x  10  radians  per 
second  x  60  degrees  per  radian).  The  rest  is  either  due  to  the  FFT  or  it  is 
unknown. 
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FREQUENCY  IN  RRDiflNS  PER  SECOND 


Figure  3.  Turiet  Response  with  Coulomb  Friction. 


Figure  3  shows  the  effect  of  coulomb  friction  applied  to  G4.  The 
magnitude  was  O.l  pound-foot  applied  to  a  turret  of  one  slug-foot-squared 
polar  moment.  ITie  ratio  is  about  right  since  a  tank  has  a  22,000 
slug-feet-squared  polar  moment  and  about  2000  pound-feet  of  coulomb  friction 
referred  to  the  turret.  The  gain  decreased  as  the  input  was  decreased  but 
the  phase  lag  decreased  as  well. 
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FREQUENCY  IN  RADIANS  PER  SECOND 

Figure  4.  Turret  Response  With  Dead  Space  at  the  Control  Handle. 


Figure  4  shows  the  effect  of  deadspace  applied  at  (13.  The 
magnitude  of  the  deadspace  was  O.l  milliradians .  A  typical  turret 
might  have  0.04  radians  deadsoace  at  the  turret  control  handle.  The 
turret  gain  during  these  turret  response  runs  was  0.1  compared  to  a 
typical  turret  gain  of  0.02  radians  per  second  per  radian.  Obviously 
the  problem  will  require  new  coefficients  for  a  quantitative  analysis 
but  these  figures  show  the  trends. 
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FREQUENCY  IN  RRDIRNS  PER  SECOND 


Figure  5.  Turret  Response  With  Backlash  at  the  Control  Handle. 


Figure  5  shows  the  effect  of  backlash  applied  at  the  turret- 
control.  The  magnitude  of  the  backlash  was  0.04  milUradians.  Once 
again  the  level  chosen  was  not  necessarily  representative  ot  real 
turrets,  however  it  does  show  the  relative  effects  of  backlash  on  gain 
and  phase.  Backlash  at  the  control  handle  will  cause  a  nhase  lag 
without  changing  the  gain  substantially. 
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Figure  6.  Turret  Response  With  Backlash  at  the  Turret  Output. 


Figure  6  shows  the  effect  of  0.001  milliradian  of  backlash  on  the 
output.  Here  the  backlash  can  be  seen  to  have  a  greater  effect  at 
higher  frequencies  as  compared  to  backlash  on  the  input.  The 
reduction  in  amplitude  with  increased  frequency  at  the  output  causes 
this  effect. 

The  objective  of  presenting  these  figures  is  to  indicate  that  it 
will  be  possible  to  shape  the  gain-phase  characteristics  of  the  turret 
model.  This  will  be  done  when  the  test  data  from  the  tank  turret 
become  available. 
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V.  EFFECTS  OF  NONLINEARITIES  ON  LOOP  RESPONSE 


The  intent  at  this  point  was  to  calculate  the  rms  error  for  the 
closed-loop  system  when  tracking  the  target  course  developed  earlier.  The 
gain-phase  plots  for  the  open-loop  response  of  the  man  and  turret  were  also 
of  interest,  but  as  explained  earlier  the  gain-phase  plots  were  usable  only 
for  the  condition  with  low  levels  of  nonlinearities.  Figure  7  shows  these 
plots  for  a  condition  with  no  nonlinearities.  This  condition  had  a  phase 
margin  of  41  degrees,  a  gain  margin  of  4,8  db  and  an  rms  error  of  0.31 
milliradians .  The  cross-over  frequency  (0  db  gain)  was  3.0  radians  per 
second . 


Frequency*  rediens  per  second 


Figure  7.  Gain-Phase  Plot  Without  Nonlinearities. 


When  the  nonlinearities  were  added  the  loop  was  optimized  for  minimum  ? 

rms  error.  The  rms  error  for  no  nonlinearities  dropped  to  0.26  milliradians  , 

but  the  loop  was  not  nearly  as  stable.  The  phase  margin  was  only  13  degrees  I 

and  the  gain  margin  was  1,4  db.  The  growth  in  rms  error  with  increased  i 

levels  of  nonlinearities  is  shown  in  Figures  8,  9,  and  10.  The  deadspace  in  | 

Figure  8  is  at  the  control  handle.  The  turret  gain  was  changed  to  0.01  (BK  j 

=  0.10,  B  =  100)  for  these  runs.  The  coulomb  friction  in  Figure  9  was  \ 

applied  to  G4.  The  backlash  in  Figure  10  was  applied  to  the  control 

handle .  4 
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re  8.  Tracking  Error  with  Dead  Space  at  the  Control  Handle. 


9.  Tracking  Error  With  Coulomb  Friction  at  the  Turret  Output 
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Figure  10.  Tracking  Error  with  Backlash  at  the  Control  Handle. 


The  only  conclusion  that  can  be  reached  at  this  time  regarding  Figures 
8,  9,  and  10  is  that  the  level  of  nonlinearities  that  were  used  did  have  an 
influence  on  tracking  error.  It  remains  to  be  seen  if  these  are  the 
appropriate  levels.  The  turret  measurement  tests  will  determine  the 
appropriate  levels  to  use.  It  also  remains  to  be  proven  that  the  man-model 
used  here  is  appropriate  for  this  task.  The  human  tracking  tests  will 
determine  that. 


VI.  SUMMARY 

A  control  loop  with  a  man-model  and  with  provision  for  nonlinearities 
was  developed.  An  optimization  algorithm  for  the  adaptive  man-model 
worked  well  for  low  levels  of  nonlinearities,  but  it  had  to  be  simplified  to 
work  for  high  levels  of  nonlinearities.  Nonlinearities  ^'ere  shown  to 

influence  tracking  error. 

The  next  phase  of  this  effort  will  have  the  benefit  of  quantitative 
descriptions  of  the  turret  response.  The  turret  will  be  simulated  in  more 
detail  and  the  correct  parameter  values  will  be  used  for  nominal  conditions. 
Another  attempt  will  be  made  to  improve  the  adaptive  man-model  to  work  wii.h 
the  appropriate  nonlinearities. 
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PROGRAM  CUNTRL 

THIS  PROGRAM  SIMULATES  A  TANK  GUNNER  TRACKING  A  TARGET. 
ON  DEMAND  IT  WILL  ADJUST  THE  PARAMETERS  OF  THE  MAN 
TO  GIVE  THE  LOWEST  COST  OR  ERROR. 

IT  WILL  ALSO  PRODUCE  BODE  PLOTS  ON  PRINTER  AND  IN  A 
FILE  FOR  USE  BY  A  PLO'fTLR. 

THE  PROGRAM  IS  INTI^RACTIVE,  AND  PROMPTS  ALL  INPUTS. 

A  CARRIAGE  RETURN  IS  SUFFICIENT  FOR  AN  ANSWER  OF 
ZERO  OR  NO. 

TWO  PROMPTS  REQUIRE  MULTIPLE  INPUTS 
ON  ONE  LINE,  SEPERATED  BY  COMMAS. 

FIRST  SET: 

TRAILING  ZERO  VALUES  MAY  BE  IGNORED, 

COMMAS  ARE  SUFFICIENT  FOR  NONTRAILING  ZERO  FIELDS. 
TAU  TRANSPORT  DELAY  IN  SECONDS 

B  VISCOUS  FRICTION 

BK  PLANT  GAIN 

BKLSH  BACKLASH  AT  OUTPUT  IN  RADIANS 

CF  COULOMB  FRICTION 

DEDSPC  DEADSPACE  AT  INPUT  IN  RADIANS 


‘’ECOND  SET: 
TI 
K 
TL 


INTEGRATION  TIME  IN  SECONDS 

GAIN  OF  NAN 

LEAD  TIME  IN  SECONDS 


INSTEAD  OF  THE  SECOND  SET.  DEFAULTS  OF 
TI  =  .01.  K  =  2.5  *  B,  AND  Tl  =  TI  +  1/B 
MAY  BE  CALLED  BY  A  CARRIAGE  RETURN. 

THE  PLANT  IS  NORMALIZED  TO  A  MASS  OF  1. 

SUBROUTINES  IN  THE  PACKAGE: 

THE  MAIN  PART  OF  THE  PROGRAM  DOES  ALL  THE  INTERACTIVE 
CONVERSATION  AND  CALLS  PLANT© .  AUTO.  FUN.  AND  MACHINE. 

SUDROUTINE  AUTO 

SETS  UP  THE  AUTOMATIC  OPTIMIZATION 
CALLS  FUN  AND  FNMIN. 

THE  PARAMETER  ACRCY  IN  AUTO  TELLS  FNMIN 
THE  PRECISION  DESIRED. 

THE  AUTOMATIC  MINIMIZATION  ALSO  TERMINATES  IF  TI 
BECOMES  LESS  THAN  .005 


SUDROUTINE  FNMIN 

DOES  THE  AUTOMATIC  OPTIMIZ.ATION 

CALLS  FUN 

IF  AUTOMATIC  MINIMIZATION  IS  CHOSEN 
FNMIN  SYSTeiATICALY  VARIES 

X(  1  )  =  I  /  TI .  X(  2  )  =  K.  AND  X(  3  )  =  TL 
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o  TO  MINIMIZE  THE  COST  RETURNED  BY  FUNCTION  FUN. 

c  X(  1  )  IS  INVERTED  TO  AVOID  NEGATIVE  VALUES, 

o 

c  FUNCTION  FUN 

o  MODELS  THE  CONTROL  LOOP 

o  COMPUTES  THE  COST  OF  TRACKING 

o  CALLS  MAN0,  PLANT 1 ,  STATS0,  MANl ,  TGTS,  STATS 1 ,  PLANT2, 

c  STATS2,  STATSW,  AND  FFT. 

o  THE  PARAMETER  NN  IS  USED  AS  A  FLAG  IN  FUN: 

o  NN  >  0,  AUTOMATIC  REDUCTION.  NO  BODE  PLOT, 

o  NN  =  0,  BODE  PLOT  OF  MAN-MACHINE  SYSTEM 

o  USING  THE  MODEL  TARGET  AS  INPUT, 

c  NN  =  -1 ,  BODE  PLOT  OF  MACHINE  WITH  MODEL  TARGET 

o  AS  INPUT  TO  MAN. 

o  NOTE  THAT  IN  THIS  CASE  THE  TARGET  IS  FILTERED  THRU 

o  THE  MAN  AND  THE  PLOT  IS  THEREFORE  AN  IMPLICIT  FUNCTION 

o  OF  THE  MAN. 

o  NN  <  -1,  BODE  PLOT  OF  MACHINE  WITH  SINE  WAVE  INPUT, 

o 

o  SUBROUTINE  MACHINE 

o  MAKES  BODE  PLOTS  OF  THE  MACHINE 

o  CALLS  FUN  AND  PLOT, 

c 

c  SUBROUTINE  PLOT 

0  PRODUCES  A  PRETTY  BODE  PLOT  IN  A  FILE  READY  FOR  PLOTITNG 

o  PLOT  ASSUMES  THE  PLOTTING  PACKAGE 

c  TIG  (  TERMINAL  INDEPENDENT  GRAPHICS  )  WMCH  WAS 

o  WHITEN  IN  G  AND  REQUIRES  A  C  COfn>ILER. 

c 

c  SUBROUTINE  FFT 

<■  FAST  FOURIER  TRANSFORM 

c 

c  THE  HAN : 

c 

c  SUBROUTINE  rL\NO 

c  INITIALIZES  THE  MAN 

c  GALLS  TGTAO 

c 

c  SURROirriNE  H/iNI 

e  TIIE  MAN’S  PART  OF  THE  COOTROI.  LOOP 

c  CALLS  TGTAI 

c 

o  THE  PLi\NT : 

o 

o  SUBROUTINE  PLANTO 

o  INITIALIZES  THE  PLANT 

c 

c  SUBROUTINE  PIJVNTl 

o  RZSETS  PIJ\NT  AT  START  OF  FJVCH  RUN 

c 

c  SUBROUTINE  PLANT2 

c  niE  rUCHINERV’S  PART  OF  THE  CONTROL  LOOOP 

o 

c  THE  STATS: 
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o 

o  SUBROUTINE  STATS0 

c  INITIALIZES  STATISTICS  PACKAGE 

o 

c  SUBROUTINE  STATSl 

c  COLLECTS  THE  DATA 

c 

o  SUBROUTINE  STATS2 

o  FINDS  RMS  ERROR,  MFJVN  INPUT  OFFSET,  ETC 

o 

o  SUBROUTINE  STATSW 

o  WRITES  THE  STATS 

o 

o  THE  TARGET: 

o 

c  SUBROUTINE  TGTA0 

o  SETS  UP  TARGET 

o 

c  SUBROUTINE  TGTAl 

o  RUNS  TARGET 

o 

o  SUBROUTINE  TGTS 

o  SINE  WAVES  FOR  BODE  PLOTS 

o 

o  THE  PROGRAM  WAS  TO I TEN  TO  BE  RUN  ON  A  PDF  11/70 

o  USING  THE  CULC  F4P  COMPILER  AND  THE  UNIX  OPFJlAT’iNG 

0  SYSTEM. 

c  THE  PROGRAM  IS  IMPLICIT  DOUBLE  PRECISION, 

c  AND  USES  COMPLEX  AIUTHMATIC. 

o  GENERIC  NAMES  HAVE  BEEN  USED  FOR  FUNCTIONS,  IE  ABS, 

c  AND  THE  F4P  COMPILER  SELECTS  THE  PROPER  FUNCTION, 

c  IE  ABS,  CABS,  DADS,  ETC. 

c 
c 

common  b,  delta,  dcltat, 

+  Jmax,  Jmaxt,  Jmod,  k,  no,  nt,  pi,  tmax,  uni  In 
common  /  x  /  x(  10  ) 
external  fun 
real  *  0  JJ,  kk 

write  (  6 ,  5  ) 

5  format  (  •  NOW  TYPE  VALUES  FOR  TAU,  B,  DK,  BACICLASII,  ’  / 

+  ’  COULOMB  FRICTION,  AND  DEAD  SPACE  ’  ) 

accept  10,  tan,  b,  bk,  bklsh,  cf,  dedspc 
10  format  <  TflO.O  ) 

iinlin  =  abs(  bklsh  )  +  abs(  cf  )  +  obs(  dedspc  ) 

k  =  10 

Jmod  =  5 

Jmax  =  2  **  k 

Jmaxt  =  Jmax  S:  Jmod 

tstep  =  2. 

pi  =  3.1415926535 

no  =  8 

nn  =  0 
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fno  B  no 

tmax  fno  2.  *  pi 

delta  »  tmax  /  float!  Jmax  ) 

del  tat  >  tmax  /  float!  Jmaxt  ) 

write  !  6t  IS  )  tau,  delta,  b,  bk,  bklsb,  of,  dedapo,  Jmax 
15  format  !/  ’  TAU  DELTA  D  BK  BKL8H  CLFR  DEDSP  JMAX  ’  / 

+  2f6.3,  f6.1,  f6.3,  3pf6.2,  0pf6.3,  3pf6.2,  15  /  ) 

nt  =  tau  /  doltat  +  .5 

oall  plantO!  b,  bk,  bklah,  bklshl,  of,  dedapo,  deltat  ) 
write  !  6,  20  ) 

20  format  !  ’  DO  YOU  WANT  TO  LOOK  AT  THE  MACHINERY?  ’  / 

+  ’  TO  ANSWER,  TYPE  1  FOR  YES,  0  FOR  NO.  '  ) 

aooept  30,  m 
write  !  6,  25  ) 

25  format  !  /  *  DO  YOU  WANT  AUTOMATIC  REDUCTION  ?  ’  / 

+  ’  TYPE  1  FOR  YES,  OR  0  FOR  NO  ’  ) 

aooept  30,  n 
30  format  !  110  ) 

33  write  !  6,  40  ) 

40  format  !  /  ’  NOW  TYPE  VALUES  FOR  TI,  K,  AND  TL  ’  ) 

accept  10,  tl,  kk,  tl 
If  !  tl  .{jt.  0.  )  go  to  45 
tl  =  .01 
kk  =  2.5  *  b 
tl  =  tl  +  1 .  /  b 
45  x(  1  )  =  1 .  /  tl 

x(  2  )  =  kk 

x(  3  )  =  tl 

If  !  n  .gt .  0  )  call  auto 

cost  =  fun!  X,  nn  ) 

If  (  m  .cq.  1  )  call  machine 

If  (  n  . 1 o .  0  )  go  t o  35 

stop 

ond 

subroutine  auto 

Implicit  double  precision  !  a-h,  o-z  ) 
common  b,  delta,  deltat, 

+  Jmax,  Jmaxt,  Jraod,  kj,  no,  nt,  pi,  tmax,  unlln 
dimension  ops!  10  ) 
common  /  x  /  x!  10  ) 
roal  *  8  kk 
external  fun 

k  =  1 
nn  =  0 

cost  =  fun!  X,  nn  ) 
ti  =  1 .  /  x!  1  ) 
kls,  =  x!  2  ) 
tl  =  x!  3  ) 

write  !  6,  15  )  cost,  tl,  kk,  tl 
15  format  !  /  ’  THE  INITIAL  COST  WAS  ’ ,  3pf8.3  / 
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+  ’  FOR  TI  =  •  ,  0pf7.4,  •  KK  =  ’  ,  fJJ.l ,  ’  ,  XL  =  ’  ,  f7.4  // 

+  ’  TI  KK  TL  RMS  PHASMR  GAINMR  COST  SLOPE’  /  ) 

acrcy  =  .05 
e  =  6 . 
n  =  3 

do  5  i  =  1 ,  n 

ep8(  i  )  =  aoroy  *  x(  i  ) 
call  fmninl  n,  x,  cost,  fnn,  «,  t.ps ,  k  ) 
tl  =  1 .  /  x(  1  ) 
kk  =  x<  2  ) 
tl  =  x(  3  ) 

write  (  6,  10  )  oost,  tl,  kk,  tl 

format  (  /  ’  THE  MINIMUM  COST  WAS  ’  3pf6.3  / 

+  ’  FOR  TI  =  ’ ,  0pf7.4,  • ,  KK  =  * ,  fS.l ,  ’ ,  TL  =  ’ ,  f7.4  ) 

return 

end 

function  fun(  x,  nn  ) 

Implicit  double  precision  (  a~h,  o-z  ) 
common  b,  delta,  deltat, 

-t  Jmax,  Jmaxt,  Jmod,  k,  no,  nt ,  pi,  tmax,  uni  In 
common  /  gp  /  gaani  10,  7  ),  phaas(  10,  7  ) 
dimension  galnC  81  ),  phase!  81  > 
dimension  gl (  100  ) 

dimension  frin(  1024  ),  filn(  1024  ),  front (  1024  ), 

+  flout!  1024  ) 
dimension  x!  10  ) 

complex  oln,  oout,  orin,  crout,  serin,  sorout,  oxx,  cyy 
r«al*4  filnl,  floutl,  frini,  froutl 
data  008 tran  /  1  .  / 


if 

! 

x( 

1 

)  .lo. 

0. 

.or.  x!  2  ) 

•  le . 

0. 

.or.  x!  3  ) 

.le. 

0. 

) 

cos  t 

= 

1 

■  e+2 

if 

! 

x( 

i 

)  .le. 

0. 

.or.  x!  2  ) 

.  le. 

0. 

. or .  x!  3  ) 

.  lo . 

0. 

) 

+  go  to  900 

call  manO!  deltat,  nt,  x  ) 
call  plan' ’ !  h  ) 
points  =  jmax 

if  (  nu  .eq.  0  )  write  !  6,  55  ) 

format  !  /  27x,  4h-i.0,  6x,  4h-0.5,  7x,  3h0.0,  7x,  3h0.5, 

+  ’  1.0’  / 

+  ’  SEC  REF  IN  OUT  +’ ,  4!  9x,  lh+  )  ) 

if  !  nn  .oq.  -1  )  write  !  6,  56  ) 

format  !  27x,  ’-250  -125.  0.0  123.’ 

+  ’  250’  / 

+  ’  SEC  REF  IN  OUT  +’ ,  4!  9x,  Ih+  )  ) 

call  statsO!  delta,  Jmax  ) 

Jem  =  2 
Jmx  =  Jmaxt 
Jcl  =  Jem 

if  !  nn  .go.  -1  )  Jcl  =  1 

NOW  MODEL  THE  CONTROL  LOOP 
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do  101  Jot  =  Jol,  Jom 
Jm  =  0 

If  (  Jet  .eq.  Jem  )  Jmz  =  Jnaxt 
do  100  J  =  1 ,  Jmx 

if  (  nn  •ge.  -  1  )  call  nanl (  bi  J)  nt «  diffdtt  dlfft,  g3  ) 
if  (  nn  <lt.  -1  )  eall  tcrtsl  J«  gS  ) 
if  (  Jot  .It.  Jem  )  go  to  90 

if  (  mode  J«  Jmod  )  .ne.  0  )  go  to  90 
Jm  =  Jm  +  1 

if  (  nn  .ge.  0  )  frln(  Jm  )  =  dlffdt 

if  (  nn  .It.  0  )  frln(  Jm  )  ^  g3 

front!  Jm  )  =  h 

fiin(  Jm  )  =  0. 

fiont(  Jm  )  =  0. 

if  (  nn  .go.  -1  ) 

+  call  atatal!  dlfft,  frin(  Jm  ),  front!  Jm  ),  Jm  ) 

90  call  plant2!  g3,  h  ) 

100  oontinne 

101  continue 

if  !  nn  .go.  -1  ) 

+  call  stat82!  avcin,  avoont,  rms  ) 
do  120  J  =  1 ,  Jraax 
tj  =  J 

frln!  J  )  =  frln!  J  )  -  ovoin 
front!  J  )  =  front!  J  )  ~  avoont 

120  continue 

121  continue 

If  (  nn  .gt.  0  .or.  nn  .It.  -1  )  go  to  170 
do  150  J  =  1,  199,  3 
t  =  float!  J  )  *  delta 
If  !  nn  .eq.  0  )  n  =  frin!  J  )  *  20000. 

if  !  nn  .it.  0  )  n  =  frin!  J  )  *  80. 

ref  =  frin!  J  )  +  front!  J  ) 
if  !  n  .gt.  -21  ) 

+  write  !  6,  140  )  t,  ref,  frin!  J  ),  front!  J  ) 

if  (  n  .le.  -21  )  write  !  6,  142  )  t,  ref,  frin!  J  ),  front!  J  ) 

150  continue 

140  format  (  lx,  f6.2,  3p3f7.2,  <n+21>x,  Ih*  ) 

141  format  (  lx,  4el0.3  ) 

142  format  (  f7.2,  3p3f7.2  ) 

170  if  (  nn  .eq,  0  )  call  statsw 

175  call  fft  (  frln,  flln,  k  ) 

call  fft  !  front,  flout,  k  ) 
nav  =  nc 

If  (  nn  .It.  -1  )  nav  =  1 

Irads  =  1 
iradm  =  42 

If  (  nn  .It.  -1  )  Iradm  =  1  -  nn 
If  (  nn  .It.  -1  )  Irads  =  Iradm 
do  500  Irad  =  irads,  iradm 
serin  =  0, 
serout  =  0. 
do  400  J  =  1 ,  nav 

1  =  nav  !  1  rad  -  1  )  +  J 
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frini  =  frlu(  1  ) 
fllnl  =  fHn(  1  ) 
cln  =  omplxl  frlnl,  fllnl  ) 
froutl  =  front!  1  ) 
fioutl  =  flout!  1  ) 
cout  =  cmplx!  froutl,  flontl  ) 
crln  =  oln  *  conjg!  oln  ) 
crout  =  oout  *  oonJs!  cln  ) 
if  !  aba!  orin  )  .le.  1 .e-10 
+  .or.  nn  .It.  -1  .or.  nn  .gt.  0 
.or.  1  .gt.  80  )  go  to  391 
oxx  =  crout  /  orln 
oyy  =  aba!  oxx  ) 

gan  =  20.  *  loglO!  real!  cyy  )  ) 

fax  ~  atan2!  almag!  orout  ),  real!  crout  )  ) 

fax  =  180.  *  fax  /  pi 

enl  =  real!  orln  ) 

enl  =  aqrt!  enl  ) 

oyy  =>  aba!  oout  ) 

eno  =  real!  oyy  ) 

If  !  aba!  ono  )  .gt.  1 .o-lO  )  write  1  6,  390  ) 

1,  frln!  1  ),  flln!  i  ),  frout!  1  ).  flout!  1  ). 

*  gan,  fax,  enl,  eno 

390  format  !  18,  4f8.4,  2f0.2,  2f8.4  ) 

391  continue 
Bcrln  *  serin  +  crln 
scrout  =  acrout  +  crout 

cout  I  n\>o 

If  !  acrout  .oq.  0.  )  write  (  6,  450  ) 

If  !  aba!  acrout  )  .gt.  l.e+10  )wrlte  !  6,  451  ) 

1 .  /  x!  I  ) ,  x!  2  ) ,  x!  3  ) 
format  !  /  f7.4.  f7.2,  f7.4.  •  UNSTABLE  •  /  ) 
format  !  /  ’  INPUT  TOO  SMALL  *  /  ) 

If  !  acrout  .oq.  0.  .or.  nbf>!  acrout  )  .gt.  l.e  +  10  ) 
cost  =  I . 0+1 

If  (  scrout  .oq.  0.  .or.  aba!  acrout  )  .gt,  l.o+lO  ) 
go  to  900 
exx  =  0. 

If  !  aba!  acr’.n  )  .gt  .  l.e-30  )  oxx  =  scrout  /  sorln 
cyy  =  obs!  exx  ) 
gain!  1  rad  )  =  real!  cyy  ) 

phase!  Irad  )  =  atan2!  almag!  acrout  ),  real!  scrout  1  ) 
If  !  phase!  Irad  )  .gt.  O.  ) 
phase!  Irad  )  =  phase!  Irad  )  -  2.  *  pi 
oont  1  niie 

If  !  nil  .gt.  0  .or.  nn  .It.  ~nc  )  go  to  540 

If  !  nn  .oq.  0  )  Idbmn  =  “10 

If  !  nn  .eq.  -1  )  Idbmu  =  -60 

If  !  nn  .It.  -1  )  Idbran  =  -70 

Idbmx  =  Idbmn  +  30 

write  !  6,  510  )  !  Idb,  Idb  =  Idbmn,  Idbmx,  10  ) 
format  !  /  20x,  ’PHASE  SHIFT’,  20x,  7hDB  GAIN  / 

’  FHF.Q  PH  GAIN  -180’,  15x,  ’-90’, 

14,  3!  7x,  13  )  ) 


400 

+ 

451 

450 

+ 

+ 


+ 

500 


510 

+ 

+ 
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writ©  (  6,  830  ) 

530  format  (  lx,  lh+,  4(  Sx,  Ili+  ),  3x,  lh+,  3(  9x,  lli+  )  ) 

540  XX  =  180.  /  pi 

radf  =  2.  *  pi  *  float!  nav  )  /  tnax 
npm  3  52 

if  (  nn  .It,  0  )  npm  =  ni?m  -  idbmn  -  10 
11  »  1 

im  =  40 

if  (  nn  .It.  -1  )  11  s  1  -nn 
if  (  nn  .It.  -1  )  Im  =  1  -  nn 
do  600  1  -  11,  Im 

If  (  gain(  1  )  .le.  1.  .or.  galn(  l-t-l  )  .gt.  1.  ) 

+  go  to  890 

phaamr  =  180.  +  xx  *  (  phaaet  1  >  - 
+  (  phase!  1  )  -  phaae!  1+1  )  ) 

+  *!galn!l)-l.) 

+  /  !  gain!  1  )  -  gain!  1+1  )  )  ) 

If  !  1  .eq.  1  ) 

+  slope  8  20.  *  loglO!  gain!  1  )  /  gain!  1+1  )  ) 

+  /  loglO!  1.  /  3.  ) 

If  !  1  .gt.  1  ) 

+  slope  =  20.  *  loglO!  gain!  1-1  )  /  gain!  1+2  )  ) 

+  /  legl0t  !  float!  1-1  )  -  .5  ) 

+  /  !  float!  1+1  )  +  .5  )  ) 

590  n  =  phnso!  1  )  *  xx 

up  =  n  /  5 

gnn  =  20.  *  loglO!  gain!  I  )  ) 
ro  =  gnn 

rf  =  radf  *  !  float!  1)  -  .5  ) 

If  !  nu  .It.  -I  )  rf  8  rf  -  .5  /’  float!  no  ) 
nrf  8  rf  +  .001 

If  !  nn  .oq.  -no  )  111  =  111  +  I 

If  !  nn  .go.  -1  .or.  nrf  .It.  1  .or.  Ill  .It.  1  )  go  to  595 

If  !  nn  .It.  -1  )  gaan!  nrf,  ill  )  =  gnn 

If  !  nn  .It.  -1  )  phans!  nrf.  111  )  =  phase!  1  )  *  xx 
595  continue 

if  !  nn  .lo,  0  .and.  np  .gt.  -55  .and.  m  .gt .  2-npir  ) 

+  write  !  6,  610  )  rf ,  n,  gan 

If  !  nn  .lo.  0  .and.  !  np  .lo.  -55  .or.  m  .lo.  2-npm  ) 

+  .and.  gnn  .gt.  -100.  ) 

+  write  !  6,  611  )  rf,  n,  gan 

If  !  phase!  1  )  .gt.  -pi  .and.  phase!  1+1  )  .It.  -pi  ) 

+  guiiunr  =  -  20.  *  loglO!  gain!  1  ) 

+  -  !  gain!  I  )  -  gain!  1+1  )  ) 

+  *  !  phnso!  1  )  +  pi  ) 

+  /  !  phase!  1  )  -  phase!  i+l  )  )  ) 

If  !  nn  .It.  - 1  )  go  to  600 

If  !  phnso!  I  )  .It.  —pi  .and.  gain!  1  )  .It.  1.  )goto  700 
600  continue 

610  format  !  lx,  f5.2,  15,  fS.l,  t<np+56>,  Ih*,  t<m+npm>,  lh+  ) 

611  format  !  lx,  f5.2,  15,  f5.1  ) 

620  format  !  lx,  flO.l,  110,  flO.3  ) 

if  !  nn  .go.  -I  )  write  !  6,  630  ) 

630  format  !  ’  FELL  TlllVU  600  LOOP  ’  ) 
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700  coat  =  rma 
go  to  701 

If  (  phaanr  . ne .  0 .  ) 

+  cost  ®  Tins  /  sln(  phaanr  #  pi  /  90.  ) 

If  (  gainnr  .It.  6.  .and.  galtuar  .gt.  0.  ) 

+  cost  =  cost  /  sln(  gaininr  /  6.  *  pi  /  2.  ) 

701  continue 

If  (  nn  .eq.  0  ) 

+  write  (  6,  7S0  )  phaanr «  gainnr »  coat,  slope 
750  fornat  (  /  •  THE  PHASE  MARGIN  IS  f5.0,  •  DEGREES  ’  / 

+  •  THE  CAIN  MARGIN  IS  f6.1,  •  DB.  ’  / 

+  *  THE  COST  IS  * ,  3pfl2.3  / 

+  ’  THE  SLOPE  IS  ’ ,  0pf6.1,  •  DB  PER  DECADE.  *  /  ) 

ti  »  1.  /  x(  1  ) 

If  (  nn  .gt.  0  .and.  coat  .It.  1.  )  write  (  6,  800  ) 

■t  tl  I  x(  2  ) ,  x(  3  ) ,  rmst  phasnri  gainnr.  oust,  slope 
800  fornat  (  f7.4,  f7.2.  f7.4,  3pf7.3.  0p2f7.3,  3pf*  3,  0pf7.2  ) 
if  (  tl  .It.  .005  .and.  cost  .It.  costnn  )  cost  ~  ~  cost 
oostmn  =  nln(  coat,  costnn  ) 
fun  =  coat 
900  return 


end 

subroutine  naohlno 

Inpllolt  double  precision  (  n~h,  o-z  ) 
common  b«  delta,  doltat. 

Jmax.  Jmaxt.  Jnod.  kj.  nc .  nt .  pi.  tnox.  ur.lln 
common  gp  gann(  10,  7  ),  phansl  10,  7  ) 
common  /  murk  /  mark(  8  ) 
common  /  tgta  /  o,  w 
common  /x/x(  10) 
byte  or 

data  mark  /  ’+’  .  **’  ,  ’  x’  ,  ’o’  ,  ’s’  .  ,  ’n’  / 

or  =  “015 


write  (  6,  5  ) 

5  format  (/  •  HOW  LOOK  AT  MACHINE  ONLY  ’  /  ) 

n  =  -1 

cost  =  fuii(  X,  n  ) 
write  (  6,  10  ) 

10  format  (  /  ’  BODE  PLOTS  FOR  SINUSOIDAL  DRIVING  FUNCTIONS  *  /  ) 

do  200  k  =  I,  7 

a  =  .1  /  2  **  (  k~l  ) 
write  (  6,  20  )  a 

20  format  (  /  lx,  3pf6.2.  ’  MILLIRADIANS  PER  SECOND  AMPLITUDE.  ’  ) 

km  =  k 

do  100  1  =  1 ,  10 

w=  deltat  float(  1  ) 

n  =  -  nc  *  I 

cost  =  fun(  X,  n  ) 

If  (  cost  .gt.  1.  )  go  to  300 

100  continue 
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If  (  uni  in  .eq.  0  )  go  to  300 

200  continue 

300  write  (  6,  320  ) 

320  format  (  //  ’  CONSOLIDATED  PLOT  *  // 

+  2031,  ’  PHASE  SHIFT  ’  ,  20x,  *  DB  GAIN  ’ 

+  /  ’  FUEO  -225  -180  -135  -90  ’ 

+  ’  -70  -60  -50  -40’  / 

+  10X,  lh+,  3(  Bx,  lh+  ),  3x,  lh+,  3(9x,  lh+  )  ) 

do  400  1  =  1,  10 
write  (  6,  330  )  i 
330  format  (  iS,  •  ) 

Itpm  =  uwrlte  (  1,  or,  1  ) 

do  350  k  =  1 ,  kiB 
m  =  gaan(  i ,  k  ) 
np  =  phaaa(  i,  k  )  /  5. 
if  (  m  .gt.  -100  .and.  np  .ge.  -54 
+  .and.  m  .It.  0  .and.  np  .It.  0  ) 


+ 

write  t  6,  340  )  markt 

k  ).  markt  k  ) 

340 

format  t  t<np+56>,  al , 

t<m+112>,  al,  8 

1 tpm  =  uwrl tot  1 ,  or 

1  ) 

350 

cont Inue 

write  t  6,  360  ) 

360 

format  t  lx  ) 

400 

cont 1 nuo 

coll  plot(  km  ) 
return 


end 

subroutine  plot(  n  ) 

implicit  double  precision  (  o-h,  o-z  ) 
common  /  gp  /  gaan(  10,  7  )♦  phaasl  10,  7  ) 
common  /  mark  /  ronrk(  8  ) 
dimension  ixp<  10  >,  iyp(  10  ),  lyg(  10  ) 
byte  dov(  4  ),  filet  10  ) 

external  ffnxls,  ffline,  ffnoworlgln,  ffoutpat 
data  dov  /  ’v’ ,  ’ t’ ,  ’o’ ,  0  / 

data  file  /  ’d’,  ’a’,  'f,  ’a’,  ’p’,  ’o’,  ’t’, 

+  2*0/ 

call  callcC  ffoutput,  file,  0  ) 
call  onllct  ffnoworiglu,  1000,  1000  ) 
call  cal  lot  ffaxis,  ’  FREQUENCY  IN  RADIANS  PFJl  SECOND 
+  0,  0,  6000,  0.0,  0.  0..  1.,  600  ) 

call  oallct  ffaxis,  ’  PHASF.  IN  RADIANS  ==  GAIN  IN  DD 
+  0,  0,  -6000,  90.,  0,  -200.,  20.,  600  ) 

Jmx  =  10 
do  100  1  =  1  ,  n 
do  90  J  =  1 ,  10 

iygt  J  )  =  gaant  J,  1  )  *  30.  +  6000. 
lypt  J  )  =  plinast  J,  1  )  *  30.  +  6000. 
ixpt  J  )  =  J  *  600 
90  continue 
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call  calloC  ffline,  Ixp,  lyp,  10«  nark(  i  ),  1  ) 
call  callo(  ffline,  Ixp,  iygr«  10«  mark!  1  >,  1  ) 
100  continue 
return 

end 


anbroutlne  tgtaO 

Implicit  double  preolalon  (  a-h,  o-z  ) 
common  b,  delta,  deltat, 

+  jmax,  Jmaxt ,  Jmod,  k,  no,  nt,  pi,  tmax,  uni  in 
common  /  tgto  /  dt,  h,  hdt ,  hllm,  ood,  poa,  vdt 

dlatO  B  4000. 

dt  B  deltat 

hllm  B  pi  /  B, 

poa  B  0. 

h  B  hllm 

vel  B  10. 

hdot  =  vel  /  SO. 

hdt  B  hdot  *  deltat 

ood  B  1 .  /  distO 

vdt  B  vel  *  deltat 

return 


subroutine  tgtall  J,  dither,  e  ) 

lipllclt  double  precision  (  a-h,  o-z  ) 
common  y'  tgto  /  dt,  h,  hdt,  hllm,  ood,  pos,  vdt 

if  (  nbsl  h  )  .go.  hllm  .and.  h  Z  hdt  .gt.  0.  ) 

+  hdt  =  -  hdt 
h  =  h  +  hdt 

pos  =  pos  +  sln(  h  )  vdt 
dtf  =  dt  *  flont(  J  ) 
angle  =  ood  *  pos 

dither  =  ood  *  (  .1  *  slnt  1.5  *  dtf  ) 

+  +  ,1  *  sln(  1 .  +  2.5  *  dtf  ) 

++.!«(  sin(  2.  +  3.5  *  dtf  ) 

+  +  8ln(  3.  +  4.5  *  dtf  )  +  sln(  4.  +  5.5  *  dtf  ) 

+  +  sin(  5.  +  6.5  *  dtf  )  +  sln(  6.  +  7.5  dtf  )  )  ) 
g  =  angle 
return 

end 

subrotitlno  tgts(  J,  g  ) 

implicit  double  precision  (  a-h,  o-z  ) 
common  /  tgts  /  a,  w 
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g  =  a  *  sln(  w  *  float!  J  )  ) 
return 
o 

end 

subroutine  fnnln(nix,fx,fun,e teps.k) 
tnpllolt  double  proolalon  (  a~h«  o-z  > 

dimension  z( 10) teps( 10) ,se(10)«q(10)|h(10|10)(Xl(10))Xo(lO) 
real^tB  mj , lnda«  1 1 1 12<  13,  Imln,  mjfot 
o 

mjfot  B  2. 

o  reduood  from  20.  In  BRL  version  to  tame  subroutine 

m=n 

do  1  1  =  1  ,ra 
ae( 1 )Bops( 1 ) 
q( 1 ) =80 ( 1 )#o 
xl ( 1 )=x( 1 ) 
xo ( 1 ) =xl ( 1 ) 
do  2  J=  1  ,m 

2  h(l.J)=0.0 
1  h(l.l)=1.0 

o  ic  la  the  Iteration  counter  and  Jc  is  the 

c  function  ovnluntlon  counter. 

ic=l 
Jc  =  0 
lr3=5 
go  to  112 

3  imax=20*m 
fmi n=  f bar 
fO=fbar 

f J=fbar 
dol=0.0 

assign  30  to  irl 

o  begin  Iteration 

50  do  41  J=  1  ,m 

nij=  mjfct  *<iJ 
go  to  100 

30  q(  J ) =max( so ( J ) , abs ( Imdo  )  ) 

1 f (abs (del ) .gt . abs ( f J-f bar ) )goto  41 
do  1  =  f  J-f bar 
Jd  =  J 

41  fj=fbar 

o  clieck  oonvorgonce 

I f ( i c . go . imaxlgo t o  91 
lr2=l 
kl  =  l 

psil=0.0 
erain=200. 
do  63  1  =  1  ,m 
t2=abs(xi(l )-xo( 1 ) ) 
if(t2.oq.  0.)  go  to  63 
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If(t2.ge.ep8(l))  lr2*2 
pail  =psi  1 -1-12:1:12 
I3=ep8( 1 )/l2 
if(l3.11.einln)  einin=l3 
63  oonlinue 

go  lo  (90,70),ir2 

o  check  dealrablllly  of  new  direcliou 

70  do  73  1  =  1, ID 

73  x(l)=xl(l)-lxl(l)-xo(l) 
lr3=6 
go  lo  112 
78  fl«f0 

p8tl=84rl(pell) 
emtn=emln:Kp8l  1 

Il=-P8ll 

f2=finln 
12=0.0 
f3=fbar 
13=pai 1 

If (f3.ge.fl)golo  72 

lf((fl-(f2-lf2)-lf3)#(fl-f2-del)»*2.go.  .5»del*(f l-f3)**2)golo  72 
o  compute  new  direction  and  are  dlreotlons 

c  i  =  l,2,3,.*«,Jd**l,Jd^l,*«*,n,  new 

JJ=m-l 

lf(Jd-m)81 ,83,81 

81  do  82  l=Jd,JJ 
se  ( I )  =80  (  i-ll ) 
q(n=q(l-H) 
do  82  Jl=l,m 

82  h(l,Jl)=h(i-H  ,J1) 

83  do  84  Jl=l,m 

84  h(m, Jl )=<xl ( J1 )-xo( J1 ) )/p8i 1 
se(ro)=omln 

q(m) =psi 1 
qj=p8l  I 

mj  =  mjfot  *  psll 
J=m 

assign  72  to  Irl 
go  to  400 

o  prepare  for  new  Iteration 

72  do  71  1  =  1  ,m 

71  xo( 1 )=xl < 1 ) 
f0=fmln 

f J=fmln 

del=0 

lc=lc-*-l 

assign  30  to  irl 
go  to  50 

o  prepare  to  return 

91  kl=2 

90  do  92  i  =  l  ,m 

92  x(i)=xl(i) 
fx=fmln 

if (k)93,96,93 
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93  k=kl 
97  return 

96  if (kl-l)94,97,94 

94  write(6,90)  ImaXikl 

95  foriaat(241i  funinln — not  converged — ,i3,15h  iterations, k  *,12) 
stop 

o  find  minimum  along  a  line  (initial  steps) 

100  12=0 

f2=fmin 
lmda=qj 
lr3=l 
go  to  110 

102  if (fbar.gt.f2)goto  103 

11  =  12 

fl  =  f2 
12=lmda 
f2=fbar 
lmda=qj+qj 
lr3=2 
go  to  110 
105  13=lmda 
f3=fbar 
go  to  400 

103  13=lmda 
f3=fbar 
lmda=-qj 
ir3=3 

go  to  110 

104  ll=lmda 
f l=fbar 

o  find  minimum  along  a  line 
400  tl=12-13 
t2=13-ll 
13=11-12 
t4=tl*t2*t3 
t3=tl:l!fl  +  t2!t!f2+t3!lcf3 
t4=t3/t4 
tl=ll*ll 
t2=12*12 
t3" 13^13 

lmdn=.5*((t2-t3)*fl  +  (t3-tl)*f2+(tl-t2)!»:f3)/tS 
If (t4)401 ,402,402 
401  if (abs(lmda)-mj)403,403,402 

402  lf(fl.lt.f3)goto  404 
lmda=mj 

go  to  403 
404  lrada=-mj 

403  lf(fl.lt.f2)goto  405 
lf(f3.1t.f2)goto  406 
lroin= 12 

fmln=f2 

407  1 f (abs( Imda-lmin) . 1 1 .se( J)  )  go  to  471 
1 f ( Imda . oq.0 .0)goto  408 

1 f (abs ( ( lrada-lmin)/lmda) . 1 t . .03)go to  471 
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408  lr3»4 

go  to  110 

400  Inin- 11 
fmln“f 1 
go  to  407 

406  lmin°13 
fralnafS 
go  to  407 

480  If ( Inda.gt . 12)goto  481 
If ( Imda. 1 t . 1 1 )goto  482 
lf(fbar.lt.f2)goto  483 

486  llalmda 
fl=fbar 
go  to  400 

481  1 f ( Inda.gt . 13)go to  484 
lf(fbar.lt.f2)goto  483 

487  13»lnda 
f3=fbar 
go  to  400 

482  13=12 
f3=f2 
12=11 
f2=fl 

go  to  486 

483  13=12 
f3=f2 

488  12=lrada 
f2=fbar 
go  to  400 

484  11=12 
fl  =  f2 
12=13 
f2=f3 

go  to  487 

485  11=12 
f  l  =  f2 

go  to  488 

471  linda=Iniln 
fbar=ftain 
do  473  1  =  1  ,ni 

473  xi(l)=xl(i)  +  lndn*li(J,l) 
go  to  Irl.  (30,72) 

o  prepare  to  evaluate  function 

110  do  111  l  =  l,ni 

111  x(  1  )  =xl  ( 1  )  +  lindfiS:h(  J  ,  1  ) 

112  Jc=Jc+l 
fbar=fun(x,ni) 

0  special  for  control  ccccccco 
if  (  fbar  .le.  0.  )  go  to  91 
o  special  for  control  cccccccc 
go  to  (102,105,104,480,3,75  ),ir3 

end 
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1 


2 

3 


4 


c 


c 


subroutine  fft(  fr*  fi*  k  ) 


Implicit  (ifublo  precision 
dimension  fr(  1024  )«  fil 


(  a-h «  o-z 
1024  ) 


) 


n  =  2  k 


mr  =  0 
nn  =  n  -  1 


do  2  m  =  1 •  nn 
1  “  n 
1  =  1/2 

If  (  mr  +  1  .grt.  nn  )  go  to  1 
mr  =  raod(  rar*  1  )  ^ 

If  (  mr  .le.  in  )  go  to  2 
tr  =  fr(  m  +  1  ) 
fr(  m  +  1  )  =  fr(  mr  +  1 
tr(  mr  +  1  )  =  tr 
tl  =  fl(  m  +  1  ) 
f  I  (  m  +  1  )  *  f 1 (mr  +  1  > 
fl(  mr  +  I  )  *  tl 


) 


continue 
1  =  1 

if  (  1  .go.  n  )  return 
Istop  =  2  #  1 
ol  =  1 

do4m=l«i 

n  =  3.1413026535  *  flonti  1  -  ro  )  /  ol 
wr  =  008 (  0  ) 
wl  =  slni  a  1 
do  4  I  =  m.  n,  i«tep 
J  3  1  +  1 

tr  =  wr  S:fr(  J  )”wl*fl(  J  ) 

tl  =  wr  *  fit  J  )  +  J  ^ 

fr(  J  )  =  fr(  i  )  -  tr 

fi(  J  )  3  fl(  i  )  -  tl 

fr(  I  )  =  fr(  i  )  +  tr 

fl(l  )sfl(l)+tl 
oont Inuo 
I  =  istop 
go  to  3 


end 

subroutine  mnnOi  delta,  nt ,  x  ) 


Implicit  double  precision  (  a-h,  o-z  ) 

real*0  kk  »  r.  ..i 

common  /  man  /  gH  320  ).  g2,  g3,  kk,  expt  , 

dimension  x(  10  ) 


till  . 


1 1  =  1 .  /  x(  1  ) 
kk  =  x(  2  ) 
t 1  =  x(  3  ) 
ttl  =  delta  /  tl 


1 1  tme 
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expt  =  exp(  -ttl  ) 
tlti  =  tl  /  ti 
tltme  =  1.  -  tlti  -  expt 
do  50  n  =  1 ,  nt 
50  gfK  n  )  =  0. 

g2  =  0. 

g3  =  0. 
call  tgtaO 
return 
o 

end 

o 

subroutine  nanl (  h.  J,  nt «  dlffdt«  dlfft,  gn  ) 
o 

implicit  double  preolaion  (  a-h,  o-z  ) 
real^KQ  kk 

common  /  man  /  gl (  320  ),  g2,  g3,  kk,  oxpt ,  tlti,  tltme 
o 

do  60  n  =  1 ,  nt-1 
60  gl  (  n  )  =  gl  <  n+1  ) 

call  tgtaK  J,  dither,  g  ) 
dlfft  =  g  -  h 
dlffdt  =  g  +  dither  -  h 
gl (  nt  )  =  dlffdt 

g21  =  ff2 

g2  =  kk  *  gl (  1  ) 

g3  =  oxpt  g3  +  tltmo  #  g21  +  tlti  *  g2 
gm  =  g3 
return 
c 

end 

subroutine  plantO(  b,  kb,  bk,  bki ,  cf,  ds,  dt  > 

o 

Implicit  double  precision  (  a~h,  o-z  ) 
re  a  1:^8  JJ,  kb 

common  /  plant  /  expb,  bdxpb,  bklsh,  bklshi,  cfdt,  dedspe, 
+  delta,  g3b,  g4,  hn,  hnbl 

o 

JJ  =  I. 
delta  =  dt 
t J  =  delta/  JJ 
expb  =  exp(  -b  *  kb  tj  ) 
bdxpb  =  (  1 ,  -  expb  )  /  b 
bklsh  =  bk 
bklshi  =  bkl 
cfdt  =  cf  *  tj 
dr-dspc  =  ds 
return 
o 

end 

o 

subroutine  plant! (  h  > 
c 
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Impliolt  double  precision  (  a-h,  o-z  ) 

common  /  plant  /  expb«  bdapb.  bklaht  bklabil •  ofdt,  dedspo« 
+  delta,  gSb,  g4,  hn,  hnbl 
o 

g3b  =  0 . 
g4  =  0. 
h  =  0. 
hn  =  0 . 
hnbl  =  0. 
return 
o 

end 

o 

subroutine  plant2(  g3,  h  ) 
c 

implicit  double  precision  (  a-h,  o-z  ) 

common  /  plant  /  expb,  bdxpb,  bklsh,  bklahi,  ofdt,  dedspo, 
+  delta,  g3b,  g4,  hn,  hnbl 
o 

g3bl  =  g3b 
ff3b  =  0. 

if  (  abs(  g3  )  .gt.  dedspo  ) 

+  g3b  =  g3  -  sign(  dedspo,  g3  ) 
o  if  (  abs(  gdb  -  g3bi  )  ,gt.  bklshi  ) 

o  +  g3b  =  g3b  -  sign!  bklshi,  g3b  -  g3bl  ) 
g4  =  expb  *  g4  +  bdxpb  *  g3bl 
g4  =  g4  -  slgn(  mln(  ofdt,  abs(  g4  )  ) ,  g4  > 
hnbl  =  hnbl  +  delta  *  g4 
If  (  abs(  hnbl  -  hn  )  .gt.  bklsh  ) 

+  hn  =  hnbl  -  slgnC  bklsh,  hnbl  -  hn  ) 
h  =  hn 
re  turn 

0 

end 

subroutine  stataOl  dt ,  Jmax  ) 

0 

Implicit  double  precision  (  a-h,  o-z  ) 
common  /  stats  /  delta,  points,  tmax, 

+  cjura,  sumsq,  suroln,  siuaout,  suml2,  sumo2,  k 

-t-  8umt ,  sumt2i  sural  t,  sumot 
o 

delta  =  dt 

points  =  Jmax 

tmax  =  points  delta 

sum  =  0 . 

sumsq  =  0. 

sumin  =  0. 

sumout  =  0. 

sum 12  =  0. 

sum02  =  0. 

sumt  =  0. 

surot2  =  0. 

suml t  =0. 


40 


Jan  2  10:41 


suinot  =  0. 
return 
c 

end 

c 

subroutine  statsl  (  dlfft,  frin,  front,  J  ) 
o 

implicit  double  precision  (  a-h,  o-z  ) 
common  /  stats  /  delta,  points,  tmax, 
sum,  suffisq,  sumin,  sumout,  sumi2,  siuno2, 

+  sumt ,  sumt2,  suml t ,  sumot 
o 

dt  =  dlfft 

sum  =  sum  +  dt  *  delta 

siunsq  =  sumsq  +  dt  dt  *  delta 

sumin  =  sumin  +  frin 

siimout  =  stunout  +  front 

suml2  =  suml2  +  frin  *  frin 

stimo2  =  sumo2  +  front  *  front 

tj  =  J 

sumt  =  sumt  +  tJ 
sumt2  =  sumt2  +  tJ  *  tJ 
sumlt  =  sumlt  +  frin  *  tJ 
sumot  =  sumot  +  front  tJ 
return 
o 

end 

c 

subroutine  stats2  (  avin,  avout,  rmsd  ) 

0 

implicit  doublo  precision  (  a-h,  o-z  ) 
common  /  stats  /  delta,  points,  troax, 

+  sum,  sumsq,  siunln,  sumout,  sural2,  sumo2, 

+  sumt,  8iunt2,  siunlt,  sumot 

common  /  stntw  /  rros,  oveln,  aveout, 

+  dovln,  devout,  devld,  dovod,  al ,  bi ,  ao,  bo 
c 

rms  =  sqrtC  sumsq  /  tmax  ) 
rmsd  =  rms 

avoln  =  sumin  /  i>oints 

avin  =  avein 

aveout  =  sumout  /  points 

avout  =  aveout 

sl2  =  sumi2  -  sumin  *  avein 

so2  =  sumo2  -  sumout  *  aveout 

ptsl  =  points  -  i . 

devin  =  sqrti  8i2  /  ptsl  ) 

devout  =  eqrt(  so2  /  ptsl  ) 

avct  =  sumt  /  points 

st2  =  suml 2  -  sumt  *  avet 

sit  =  sumi t  -  sumin  *  avet 

sot  =  sumot  -  sumout  *  avet 

bi  =  sit  /  8t2 

bo  =  sot  /  st2 
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al  =  avein  -  bl  *  avet 
ao  =  aveout  -  bo  *  avet 
pts2  =  points  -  2 

devid  =  sqrt  (  (  sl2  -  bi  sit  )  /  pt82  ) 
devod  =  sqrt  (  (  so2  -  bo  *  sot  )  /  pts2  ) 
return 

end 

subroutine  atatsv 

implicit  double  precision  (  a-h,  o-z  > 


common 

/  statw 

/ 

rms  t 

avein,  aveout, 

devln. 

devout 

+  devid, 

devod. 

al 

.  bi 

,  ao ,  bo 

write  ( 

6,  100 

) 

rros  t 

avein,  aveout. 

devln. 

devout 

+  devid, 

devod , 

al 

*  bi 

,  ao ,  bo 

100  format  (  ’  RMS  AVEIN  AVEOUT  DEVIN  DEVOUT  ’ 
+  ’DEVID  DEVOD  AI  BI  AO  BO  ’ 

+  /  3pllf6.3  /  ) 

return 
c 

end 
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